UNCLASSIFIED 


AD  NUMBER 


ADB008137 


NEW  LIMITATION  CHANGE 
TO 

Approved  for  public  release,  distribution 
unlimited 


FROM 

Distribution  authorized  to  U.S.  Gov't, 
agencies  only;  Test  and  Evaluation;  28  NOV 
1975.  Other  requests  shall  be  referred  to 
Electronic  Systems  Division,  Hanscom  AFB, 
MA  01731. 


AUTHORITY 


ESD  USAF  ltr , 17  Dec  1981 


THIS  PAGE  IS  UNCLASSIFIED 


UNCLASSIFIED 


AUTHORITY: 


UNCLASSIFIED 


THIS  REPORT  HAS  BEEN  DELIMITED 
AND  CLEARED  FOR  PUBLIC  RELEASE 
UNDER  DOD  DIRECTIVE  5200,20  AND 
NO  RESTRICTIONS  ARE  IMPOSED  UPON 
ITS  USE  AND  DISCLOSURE, 

DISTRIBUTION  STATEMENT  A 

APPROVED  FOR  PUBLIC  RELEASE; 
DISTRIBUTION  UNLIMITED, 


e>oo% 7 


\ C T.., 


■■Wf, 


H,n  .-1 
■'*3t 


Technical  Note 


hi.--4»jlW* -!•>•« 


Application  of  Adaptive 
Filtering  Methods 


to  Maneuvering 
I r a j e c t o ry  E s t i m a t i o n 


u~ 


; - 'p/stow- 


» MM 


!*!'  for  tin-  iiiillistic  Missile  Defense  Program  Office, 

Department  of  the  Army,  V 

ironic  Systems  Division  Contract  F1962!i-7(i-C*0002  b\ 


muter  (Met 


incoln  Laboratory 


MASSACHUSETTS  INSTITUTE  OF  TECHNOLOGY 
I ,KXIN  CTON , MASSACHUSETTS 


1975-59 


C.  B.  Chang 
R.  H.  Whiting 
M.  At :lia ns 


24  November  1975 


■•ifflA um 


Distribution  limited  to  U.S.  Government  agencies  only;  test  and  evaluation; 
28  November  1975.  Other  requests  for  this  document  must  be  referred  to 
ESD/TML  (Lincoln  Laboratory } Manscom  A Fit,  MA  01781. 

I A, 


Best  Available  Cop' ' 


Tlii'  work  reported  it;  this  document  war’-  performed  at  Lincoln  Laboratory, 
u center  for  research  operated  by  Massachusetts  Institute  of  Technology, 
This  program  is  sponsored  by  the  Ballistic  Missile  Defense  Program  Office, 
Department  of  the  Army;  it  is  supported  by  the  Ballistic  Missile  Defense 
Advanced  Technology  Center  under  Air  Force  Contract  F19628-76-C-0002. 

This  report  may  be  reproduced  to  satisfy  needs  of  U.S. Government  agencies. 


ThiyJochrMearfSjJort  has  been  reviewed  and  is  approved  for  publication. 
FOR  THE  COMMANDER 


C- 


Q 

Eut^ne  C.  Raabe,  Lt.  Col.,  USAF 
Chief,  ESD  Lincoln  Laboratory  Project  Office 


MASSACHUSETTS  INSTITUTE  OF  TECHNOLOGY 


LINCOLN  LABORATORY 


APPLICATION  OF  ADAPTIVE  FILTERING  METHODS 
TO  MANEUVERING  TRAJECTORY  ESTIMATION 


C.  B.  CHANG 
R.  H.  WHITING 
M.  ATHANS 

Group  32 


TECHNICAL  NOTE  1975-59 
24  NOVEMBER  1975 


L J 


. 1 I 


Distribution  limited  to  J.S.  Government  agencies  only;  test  and  evaluation;. 
28  No/cmber  1975.  Other  requests  for  this  document  must  be  referred  jo 
ESD/TML  (Lincoln  Laboratory),  Hanscom  AFB,  MA  01731.  J ; . 


*!  I 


A 


LEXINGTON 


MASSACHUSETTS 


ABSTRACT 


The  purpose  of  this  report  is  to  examine  several  modifi- 
cations of  extended  Kalman  filters  which  can  be  used  to  estimate 
the  position,  velocity,  and  other  key  parameters  associated  with 
maneuvering  re-entry  vehicles.  These  filters  will  be  described 
and  discussed  in  terms  of  the  fundamental  problems  of  modeling  ac- 
curacy, filter  sophistication,  and  the  real-time  computational  re- 
quirements. A nine-state,  extended  Kalman  filter  based  upon  the 
maneuvering  vehicle  dynamics  is  compared  with  several  other  candi- 
date filters.  These  candidate  filters  include  a simple  filter 
based  upon  polynomial  dynamics  decoupled  with  respect  to  the  co- 
ordinates and  a more  complex,  fully  coupled,  seven-state,  extended 
Kalman  filter  based  upon  a ballistic  re-entry  vehicle  dynamics. 

Techniques  which  adaptively  increase  the  process  noise  to  compen- 
sate for  modeling  errors  during  the  manevuers  are  examined. 
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1.  INTRODUCTION 

Estimating  the  state  and  associated  parameters  (i.e., 
tracking)  of  a re-entry  vehicle  (RV)  based  on  its  radar  measure- 
ments is  a highly  complex  problem  in  nonlinear  estimation.  Not 
only  does  the  vehicular  nonlinear  equation  of  motion  represent  an 
excessive  computational  burden,  but  the  necessity  of  identifying 
key  parameters  associated  with  vehicle  dynamics  complicates  the 

problem  even  further.  The  application  of  the  linear  Kalman  filter" 

2 3 

and  its  extension  to  the  nonlinear  case  ' for  the  tracking  of  a 

ballistic  re-entry  vehicle  (BRV)  has  been  studied  extensively  dur- 

4-11 

mg  the  past  decade.  Although  many  filters  have  been  discussed, 
they  can  generally  be  divided  into  two  categories,  i.e.,  filters 
based  upon  polynomial  modeled  dynamics  (referred  to  as  polynomial 
filters)  and  filters  based  upon  the  vehicular  nonlinear  differen- 
tial equation  of  motion  (referred  to  as  BRV  filters) . There  ex- 
ists a trade-off  between  these  two  types  of  filters  in  both  per- 

g 

formance  and  computational  requirements. 

In  many  practical  applications  of  recursive  estimation 
theory,  there  is  a problem  in  obtaining  an  exact  representation 
of  the  dynamic  process.  In  the  BRV  tracking  context,  the  BRV  fil- 
ter suffers  from  the  fact  that  the  ballistic  coefficient  which 
must  ba  identified  on-line  is  an  unknown  and  time-varying  parameter 
For  a moderate  parameter  variation,  the  ballistic  coefficient  is 
often  modeled  as  a constant  state  variable  with  the  variations  and 


uncertainties  compensated  for  by  a ficticious  process  noise  term.  ' 
The  variance  of  this  noise  term  is  related  to  the  system  structure 
and  the  variation  of  the  parameter  and  can  be  determined  on-line  by 
adaptive  filtering  methods  or  premission  by  extensive  simulation 
studies.  This  technique  has  been  applied  successfully  in  estimat- 
ing the  ballistic  coefficient  of  a ballistic  re-entry  vehicle. ^ ^ 

The  problem  of  state  and  parameter  estimation  of  a man- 
euvering re-entry  vehicle  (MARV)  has  received  scant  attention  in 
the  past.  A subject  which  has  been  discussed  in  some  detail  per- 
tains  to  the  tracking  of  maneuvering  aircraft  ' and  linear  state 
dynamics  is  usually  assumed.  The  MARV  tracking  problem  is  similar 
to  the  maneuvering  aircraft  tracking  problem  in  the  sense  that  the 
target  maneuvering  force  represents  uncertain  dynamics  in  the  equa- 
tion of  motion.  In  this  paper,  several  versions  of  the  extended 
Kalman  filter  which  can  be  used  to  estimate  the  position,  velocity, 
and  other  key  parameters  associated  with  a MARV  are  discussed. 
Similar  to  the  BRV  tracking  case,  the  basic  problem  is  still  one 
of  trading  off  the  factors  of  improved  modeling  accuracy,  filter 
sophistication,  and  computational  requirements. 

Three  filters  are  discussed.  The  most  complex  one  is 
the  extended  Kalman  filter  based  upon  a MARV  differential  equa- 
tion of  motion  (referred  to  as  the  MARV  filter) . There  are  nine 
states  in  this  filter,  i.e.,  position  (3-state),  velocity  (3-state), 
drag  (1-state) , and  lift  (2-state) . In  this  case  the  fictitious 


s 
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noise  components  affect  only  the  drag  and  lift  parameters.  The 
second  filter  is  a modified  BRV  filter.  It  utilizes  the  BRV  equa- 
tion of  motion  but  adaptively  changes  the  process  noise  level  to 
compensate  for  the  modeling  error.  The  last  filter  is  a polyno- 
mial filter  also  with  adaptive  process  noise.  The  method  of  ad- 
aptive filtering  utilized  in  these  last  two  filters  is  based  upon 

14 

that  of  Jazwmski.  The  performance  of  these  filters  is  compared 
in  terms  of  bias  and  RMS  errors  developed  through  Monte  Carlo  ex- 
ercise of  the  algorithm.  Ira jectories  with  different  levels  of 

maneuvering  severity  are  used  to  examine  sensitivity  of  perfor- 
mance with  respect  to  the  size  of  maneuver.  In  addition  since  a 
MARV  initially  re-enters  along  a ballistic  trajectory,  a BRV  fil- 
ter may  be  used  initially  with  a subsequent  switch  to  a MARV  fil- 
ter upon  detection  of  a vehicle  maneuver.  This  approach  referred 
to  as  a combined  filter  is  not  examined  in  detail,  nowever,  a gen- 
eralized likelihood  ratio  test  for  maneuver  identification  is  des- 
cribed. 

The  MARV  differential  equation  of  motion  is  defined  in 
a rectangular  (Cartesian)  coordinated  system.  A dish  radar  is 
assumed  located  at  the  center  of  the  coordinate  system.  The  mea- 
surement variables  of  the  dish  radar  include  range,  azimuth,  and 
elevation.  The  rectangular  coordinate  system  has  the  property 
that  it  makes  the  trajectory  differential  equations  less  compli- 
cated. The  disadvantage  is  that  the  measurement  equations  are 
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nonlinear  in  terms  of  the  state  variables.  The  rectangular  co- 
ordinate is  employed  here  because  it  is  better  suited  for  under- 
standing the  geometry  of  the  vehicle  maneuver. 

This  report  is  organized  as  follows.  The  MARV  differ- 
ential equations  of  motion  are  presented  in  the  next  section. 

The  generalized  maximum-likelihood  ratio  test  for  maneuver  detec- 
tion is  presented  in  the  third  section.  The  extended  Kalman  fil- 
ter equations  specific  to  the  MARV  tracking  problem  are  presented 
in  Section  4.  Section  5 presents  a review  of  adaptive  filtering 
methods.  Special  emphasis  is  given  to  Jazwinski's  adaptive  fil- 
tering method  with  application  to  the  tracking  problem.  A brief 
review  of  other  adaptive  filtering  methods  and  a discussion  on 
the  feasibility  of  their  applications  to  the  tracking  problem  are 
included.  Section  6 presents  r*”"erical  performance  results  of 
the  described  filters  for  Simula  -d  test  data.  Comparisons  of 
both  bias  and  RMS  estimation  errors  for  position,  velocity,  and 
parameters  are  presented.  The  last  section  presents  a discussion 
of  our  investigation  thus  far  and  the  direction  for  future  devel- 
opment . 

2.  MODELING  OF  MARV  DYNAMICS 

In  this  section,  the  MARV  differential  equation  of  motion 
is  presented.  A Cartesian  coordinate  system  is  employed  to  des- 
cribe these  equations  because  it  is  felt  that  this  system  is  bet- 
ter suited  for  "physical"  understanding.  A flat,  nonrotating 
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earth  with  constant  gravity  model  is  assumed.  For  the  altitude 
region  below  100  km  which  is  our  concern,  this  assumption  intro- 
duces only  insignificant  modeling  errors  while  greatly  simplify- 
ing the  equations.  When  the  vehicle  is  viewed  as  a point  mass 
re-entering  along  a ballistic  trajectory,  there  are  two  signifi- 
cant force  terms,  gravity  and  aerodynamic  drag,  acting  on  the 
vehicle.  The  drag  force  acts  opposite  to  the  velocity  vector  with 
a magnitude  proportional  to  the  air  density  and  the  square  of  the 
velocity.  When  the  vehicle  undertakes  a maneuver,  a third  force 
term  , lift,  is  introduced.  The  lift  force  is  in  a plane  perpen- 
dicular to  the  velocity  vector.  It  may  be  represented  by  the  mag- 
nitude and  the  direction  angle. 

* 

The  MARV  equations  are  stated  below. 


12  1 VxVzV 

Vx  = ~|paU+^  )VxV-ipoX-^- 


sm  y 


V V r-= = 

-SGN(y)  COS  Y-V 


1 ? , V V V 

V = -|pa{l+>/)V  v-ip«X-2— sin  > 

y * y * 


v v I : 

+SGN{y)|p5X-^2~  yv2cos2Y-V; 


vz  = -|pa{l+X2)VzV+|pXV2sinY-G 


For  derivation,  see  the  Appendix. 


(2.1) 


where 


V ,V ,V  : velocity  components  along  x,y,x  axis. 


x'  y 2 


respectively 


V:  magnitude  of  velocity 


(-  Vvx  + Vy  + vz) 


Vp:  planar  velocity 


(■^?) 


a:  drag  force  proportionality  constant,  its 

inverse  is  known  as  the  ballistic  coeffi- 
cient which  is  the  ratio  of  vehicle  mass 
to  effective  drag  area 

6:  lift  force  proportionality  constant,  it 

has  a similar  aerodynamic  meaning  as  drag 

X:  a constant  defining  the  lift  induced  drag 

y:  angle  between  lift  vector  and  the  local 

horizontal  plane.  It  has  the  following 
convention 

y positive  -*■  climb 
Y negative  -*•  dive 

-90°  < y < 90°  -*•  left  turn 
90°  < y < 2700-*  right  turn 

SGN(y):  SGN(y)  = 1 for  -90°  < y < 90° 

-1  otherwise 

p : air  density 

G:  gravitational  constant 

Notice  that  when  all  the  lift-related  parameters  are  zero  (i.e., 

X,6, y) » the  above  set  of  equations  reduce  to  the  ballistic  trajec- 
tory equations.  Similar  to  the  ballistic  vehicle  case,  the  exten- 
ded Kalman  filter  based  upon  the  above  model  would  include  position, 


6 


velocity,  and  unknown  parameters  as  state  variables.  This  state 
augmentation  method  for  parameter  identification  has  been  applied 

. 2 

successfully  when  the  parameter  undergoes  moderate  variation. 

Ideally,  one  would  like  to  identify  all  the  MARV  parameters,  namely 

6,  y,  and  X.  However,  this  makes  the  augmented  system  unobserv- 
* 

able.  A reduced-order  model  will  be  used  to  identify  a combina- 
tion of  these  parameters.  This  involves  estimating  the  tangential 

2 

deceleration  constant  a(l+X  ),  the  normal  deceleration  constant 

XS,  and  the  angle  y.  This  makes  the  MARV  estimator  a nine-state 

filter  with  position  (3-state) , velocity  (3-state) , and  three 

2 

lift/drag  parameters  [a(l+X  ),  X6,  and  y]  as  state  variables. 

The  lift  force  representation  used  in  these  equations 
is  defined  strictly  in  keeping  with  the  aerodynamics.  A disad- 
vantage of  this  model  is  that  the  angle  parameter  y is  related  to 
the  vehicle  acceleration  in  a "very"  nonlinear  fashion  (i.e.,  sine, 
cosine,  square  root,  etc.).  A method  to  make  the  parameter  rela- 
tionship appear  more  "linear"  is  to  decompose  the  lift  force  on 
an  appropriate  coordinate  system  and  then  estimate  the  magnitude 
along  the  coordinates . This  formulation  enables  the  lift  para- 
meters to  relate  to  the  acceleration  terms  in  a manner  similar  to 
that  of  the  drag  parameter  in  the  BRV  case.  One  such  possible 


The  observability  theory  for  a general  nonlinear  system  has  not 
been  found.  For  the  particular  system  studied  here,  it  can  be 
shown  that  it  is  indeed  impossible  to  separate  all  parameters 
unless  other  relations  can  be  specified. 


decomposition  which  maintains  the  lift  force  perpendicular  to  the 
drag  force  defines  a lift  force  parallel  to  the  ground  (the  turn 
force)  and  another  force  perpendicular  to  the  turn  force  (the 
climb  force) . With  this  formulation,  the  MARV  equations  may  be 
rewritten  as: 


1 2 1 2 Vv  1 VxVz 

Vx  = -|pWxa(l+X2)-ipV2X6t^  -|pVX6c-ip. 

P P 


v = -|pw.  a(l+X2)+ipV2X6t^ 

P P 


Vz  = -|pWza(l+X2)+|pWpX6c-G 


(2.2) 


where  6 and  6 are  climbing  and  turning  parameters,  respects  .y, 

C*  t 

with  the  following  sign  convention 


5 „ > 0 ->  climbing, 
c 

6^  > 0 -*■  left 


5c  < 0 -*  diving 
< 0 right  turn 


Notice  that  the  total  lift  force  constant  is  represented  by 

XS  = X l/62+62  . 
f t c 

The  nine-state  MARV  filter  presented  in  the  later  sec- 
tion is  the  extended  Kalman  filter  based  upon  Eq.  (2.2).  The  actual 

2 

parameters  estimated  are  = a(l+X  ) , at  = X6t,  and  ac  = X<$c. 

3 . MANEUVER  DETECTION 

In  this  section,  a likelihood  ratio  test  for  maneuver 
detection  is  presented.  Maneuvering  vehicles  initially  re-enter 
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along  a ballistic  trajectory.  If  a maneuver  is  initiated  while 

the  target  is  being  tracked  by  a ballistic  filter,  biases  will 

* 

begin  to  build  up  in  the  filter  residual.  The  maneuver  detec- 
tion is  designed  to  exploit  this  residual  bias.  A bias  model 
which  is  increased  linearly  with  time  is  assumed.  If  the  amount 
of  bias  is  known  a priori  to  the  detector,  the  detection  problem 
is  simplified  to  distinguish  two  Gaussian  processes  with  known 
means  and  variances.  This  simple  case  is  first  introduced  to 
establish  notation.  When  the  bias  is  unknown,  and  this  is  usually 

the  case  in  practice,  a generalized  likelihood  ratio  test  is  for- 
15 

mulated.  This  is  shown  to  be  an  extension  of  the  known  bias 
case.  When  the  bias  function  is  assumed  completely  unknown,  the 
test  is  reduced  to  the  well-known  chi-square  test.  This  case  is 
shown  in  the  last  subsection.  , 

3 . 1 Known  Bias  Case 

Assume  the  bias  in  the  residual  caused  by  a vehicle  man- 
euver during  one  measurement  interval  be  known  to  the  hypothesis 
tester  and  let  it  be  denoted  by  Ay.  It  is  assumed  using  our  as- 
sumption of  a linearly  increasing  bias,  the  bias  after  k measure- 
ments is  kAy . Let  a stack  of  K measurements  be  collected  for 

. 'V 

testing  and  Ay^_  denote  the  k-th  measurement  residual  with  covari- 
ance P , . Two  hypothesis  representing  MARV  (H. ) and  BRV  (H  ) are 
r / K o 

* " 

"Filter  residual"  is  defined  as  the  difference  of  the  measurement 
and  the  predicted  measurement. 
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k— 1 $ • • • $ 


(3.1) 


Hl=  = kA£  + 


V A£k  " 2* 

where  the  noise  term  n,  is  assumed  Gaussian  with  zero  mean  and 

— k 

covariance  P , and  is  uncorrelated  for  different  k.  The  likeli- 
r ,k 

hood  test  is  given  by 

/a^  , MARV 

p(Ay.#...#Ay]/H1)  > 

A = — < X 

p(Ay1>.../Ayk/Ho)  BRV 


= c*exp<-Tr 


(-7  T.  [( 

( k-1  L 


T -1 

Ip  -L 


(Ayk-kAy)  r,k  (Ayk~kAy) 


>(A^) 


T -1 

Pr,k(A^)  } < 
^‘-VBRV 


(3.2) 


This  equation  may  be  reduced  to  obtain  the  following  sufficient 
statistics 


K T -1  K T -1 

i = I>Ax  Pr,kA£.  - \ Pr,kA£ 

k=l  K * k=l 


(3.3) 


Notice  that  l is  a Gaussian  random  process  with  known  means  and 
variances  under  both  hypothesis.  The  performance  of  this  test  is 
well  known  and  is  characterized  by  the  normalized  separation  of 
these  two  hypotheses.1'*'  This  separation  can  be  represented  by  the 
following  definition  of  "signal-to~noise"  ratio: 


lEU/Hj.J-EU/iy  |2 
Var ( £/H1 ) +Var ( £/Ho) 


(3.4) 


t - 


where  E(  ) denotes  the  statistical  exception  and  Var ( ) the  vari- 
ance of  the  enclosed  event.  Subscript  "K"  denotes  the  integrated 
SNR  over  K measurements.  Substituting  in  the  appropriate  terms 
yields 

1 £ 2 V1 

SNR  = | £k‘ "Ay  pr,k  Ay. 


k=l 


= SNR 


K (K+l)  (2K+1) 


(3.5) 


Notice  that  SNR..  increases  rapidly  with  K. 

i\ 


3.2  Unknown  Bias  Case 

In  the  more  realistic  case  where  the  bias  term  Ay  is 
unknown  to  the  detector,  the  test  becomes  a generalized  likeli- 
hood ratio  test  which  replaces  the  Ay  by  its  maximum  likelihood 
estimate  . 11  This  results  in  the  following  modified  likelihood 
ratio . 


A = 


Max  p (Ay- , . . . , Ay^/Ay ,H. ) MARV 
_ Ay  1 K 1 > 


< 

BRV 


(3.6) 


P(^_x/  • • • /A£k/Ho) 

Letting  Ay  denote  the  maximum  likelihood  estimate  of  Ay.,  Eq.  (3.3) 


becomes 


= r^k  &y]:  - n Lk sul  r'k 

k=l  K * k=l 


(3.7) 


The  resulting  estimate  a£  is  then  given  by 

1-1. 


Ay.  = 


K 


L^P 


2„-l 


n=l 


r ,n 


E nP_1  Ay 
n=l  r'n  n 


(3.8) 


11 


V - ------  --  -- i 


For  the  case  when  K=l,  Eq.  (3.7)  becomes 

T -1 

o>  P ^ 

2.  = A^  r,k  A^ 

which  is  the  chi-square  statistic. 


3 . 3 Unknown  Bias  Function  Case 

In  the  previous  subsections,  the  bias  is  assumed  to  in- 
crease linearly  in  the  residual.  Higher  order  relations  may  also 
be  used  in  modeling  the  bias.  However,  when  a small  number  of 
measurements  are  used  in  the  detector,  the  linear  model  is  a rea- 
sonable one  to  use.  One  could  also  assume  no  knowledge  at  all 
about  the  bias  model.  In  this  case  the  hypothesis  test  can  be 


stated  as 


Hl:  + S* 

V ^ = Sk 


, k=l , * . . ,K 


(3.9) 


where  the  change  of  Ay^  with  k is  totally  unassumed.  The  general- 
ized likelihood  ratio  test  is 

Max  p (A$\  , . ,Ay  /Ay.  , . , Ay„,H1 ) MAJIV 

A = £ A (3.10; 

p(^Z1,-,^Zk/h0) 

The  maximum  likelihood  estimate  of  Ay^  is  therefore  A^  and  re- 
sults in  the  following  sufficient  statistic. 


* = 2 k=1^kPr  W 


This  is  a summation  of  K chi-square  random  variables.  Detectors 
may  be  devised  by  either  testing  the  above  summation  or  by  using 
a sequential  testing  process  utilizing  consecutive  chi-square 
statistics. 

4.  RADAR  TRACKING  FILTERS 

The  furction  of  the  tracking  filter  is  to  provide  esti- 
mates of  the  states  and  parameters  which  describe  the  motion  of 
the  re-entry  vehicle.  These  estimates  are  computed  by  means  of 
a weighted  combination  of  the  predicted  and  measured  target  states. 

The  prediction  procedure  carried  out  in  the  filter  is  based  upon 
the  assumed  target  dynamics  and  the  past  tracking  data. 

Let  the  following  vector  differential  equation  denote 
the  vehicle  dynamic  model  used  in  the  filtering  equation 

x(t)  = f (x  (t) ) + n(t)  (4.1) 

where  n(t)  is  a zero-mean  white  Gaussian  noise  process  with  covar- 

j 

iance  Q(t).  This  state  driving  noise,  which  is  sometimes  artifi- 
cially introduced  by  the  filtering  algorithm,  is  used  to  compensate 
for  the  uncertainties  that  might  exist  in  the  model.  The  measure- 
ments are  collected  from  radar  at  discrete  times  and  represented  by 
zk  = h(xk)  + vk  (4.2) 

where  vk  is  a zero  mean  Gaussian  noise  process  with  covariance  Rk- 
The  observation  function  h(*)  represents  the  transformation  from 
the  state  space  to  the  measurement  space  or  radar  measurement  vari- 
ables. This  estimation  problem  is  known  as  the  continuous  process- 

2 

discrete  measurement  problem. 
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Numerous  algorithms  have  been  proposed  for  re-entry  ve- 


hicle tracking 


4-11 


They  differ  mainly  in  the  filter  sophistica- 


tion and  the  modeling  complexity.  The  most  widely  used  filter 
structure  is  still  the  extended  Kalman  filter  regardless  of  the 
target  dynamic  model  assumed.  The  extended  Kalman  filter  is  most 
popular  because  it  offers  an  excellent  balance  between  the  compu- 
tational requirements  and  the  overall  tracking  performance.  For 
this  reason,  this  same  basic  filter  is  used  for  MARV  tracking. 

The  extended  Kalman  filter  is  stated  below  in  its  familiar  form: 
Predict  Cycle 


(state)  £t/k  = f (xt/k) 


(4.3) 


(covariance)  Pt/k  = Vt/k+Pt/kFk+Q(t) 


(4.4) 


where  denotes  the  estimate  of  x at  time  t based  upon  all  the 

data  up  to  time  tk  and  Pt/jc  denotes  the  covariance  of  x^_yk  at  time 
t conditioned  upon  all  the  data  up  to  time  t^.  is  the  Jacobian 
matrix  of  f (x(t) ) at  Xj^k.  Assuming  that  the  process  noise  is  con- 
stant from  tk  to  t^+1»  Eq.  (4.4)  may  be  approximated  by  its  dis- 


crete equivalent 


Pk+l/k  = VPk/k  + VV  {k 


(4.4a) 


where  $k  is  the  transition  matrix  of  Fk  and  At^  = t^^-t^. 


Update  Cycle 


(state)  xk+1/k+1  ik+i/k+Wk+l (?k+l"h (^k+l/kJ } (4*5) 
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(gam)  Wk+1  pk+l/kHk+l  (Hk+lPk+l/kHk+l+Rk+l) 


(covariance) 

Pk+l./k+l  = (I-Wk+lHk+l)Pk+l/k 


(4.6) 


where  Hk+^  = Jacobian  matrix  of  h(x(t))  at  xk+-jyk- 

The  filter  residual  Ay^  used  in  Section  3 is  related  to 
the  above  filtering  equation  by 

^k+1  = — k+1  " -(-k+l/k) 
with  covariance 


Pr , k+1  Hk+lPk+l/kHk+l  + ^+1 

When  the  proper  filter  optimality  conditions  are  satisfied,  the 
residual  Ay^ [ ^ has  the  same  properties  as  those  of  the  measurement 
noise  process  and  is  known  as  the  innovation  process. 

Three  filters  based  upon  varying  degrees  of  model  com- 
plexity are  discussed  in  the  remaining  part  of  this  section.  The 
first  two  filters  are  obtained  by  using  a simple  modification  of 
existing  ballistic  vehicle  tracking  filters.  This  is  made  possible 
by  introducing  substantial  process  noise  through  the  filter  so  that 
the  estimates  rely  heavier  on  the  measurement  than  on  the  target 
dynamic  model.  Without  this  modification,  these  two  filters  would 

diverge  quickly  from  the  MARY  trajectory.  The  method  of  computing 

14 

the  noise  variance  is  based  upon  that  of  Jazwinski  and  is  dis- 
cussed in  the  next  section.  The  third  filter  is  the  extended 
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Kalman  filter  based  upon  the  MARV  differential  equation  of  motion. 
All  three  filters  are  now  discussed  individually  in  their  order  of 
complexity . 


ft 


t- 


f 
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4.1  Constant  Acceleration  Model  (Polynomial  Filter) 

The  simplest  of  the  three  candidate  filters  is  referred 
to  as  the  "polynomial"  filter  because  the  motion  for  each  of  the 
three  coordinates  is  described  in  a second-order,  constant  accel- 
eration dynamic  model.  The  parameters  to  be  estimated  make  up  a 
9-dimensional  state  vector, 

x(t)  = (x,y,z,x,y,z,x,y,z)T  (4.7) 


The  coordinates  are  assumed  to  be  decoupled  resulting  in  the  simple 
linear  time- invariant  state  equation. 


x(t)  = 


0 

0 


I I 0 

- I - 
0 I I 

- I - 

0 I 0 


x(t)+n(t)  , 


(4.8) 


where  n(t)  represents  the  process  noise  term  with  covariance  level 
to  be  determined. 

Since  this  filter  does  not  explicitly  estimate  the  drag 

deceleration,  A^,  the  nonlinear  relationship  between  the  inverse 

1 2 

ballistic  coefficient,  a,  and  the  estimated  states,  Ay-gcosS^^Pv  a 
is  used  to  generate  an  estimate  of  the  drag  and  drag  parameters. 

In  this  expression  A^.  is  the  total  acceleration  along  the  velocity 


vector,  g is  the  gravitational  constant,  0 is  the  angle  between 

the  velocity  vector  and  the  line-of-sight  through  the  center  of 
1 2 

the  earth,  and  jpv  1S  the  free  air-stream  pressure.  From  the 
experience  of  using  this  filter  in  the  ballistic  re-entry  vehicle 
tracking,  the  a estimated  is  expected  to  contain  a large  random 


error . 


4.2  Constant  Drag  Model  (BRV  Filter) 

The  equations-of-motion  for  a ballistic  re-entry  vehicle 
can  be  obtained  from  Eq.(2.1)  by  letting  6=0,  A=0,  and  y=0.  These 
equations  are  completely  delineated  by  the  7~dimensior,al  state 


vector , 


x(t)  = (x,y,z,x,y,z,a) 


(4.9) 


which  forms  the  basic  parameter  set  for  the  BRV  filter. 

The  inverse  ballistic  coefficient,  a,  is  the  only  para- 
meter for  which  there  is  no  simple,  practical  model  structure  in 
terms  of  the  other  parameters.  It  is  modeled  as  a constant  Gaus- 
sian Markov  process,  a = na(t),  where  (t)  is  a zero-mean  white 
noise  process.  This  modeling  method  is  often  used  in  parameter 


t ! 

I 
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tracking,  it  is  retained  here  with  the  hope  that  it  wii  will 
provide  satisfactory  ballistic  coefficient  estimates.  In  addi- 
tion, it  indeed  requires  only  minimum  modification  to  the  ix*  it- 
ing  algorithms. 

4 . 3 Constant  Drag  and  Lift  Model  (MARV  Filter) 

The  most  complex  and  general  filter  considered  in  this 
paper  is  structured  similarly  to  the  BRV  filter  but  with  the  ad- 
dition of  the  lift  acceleration  parameters  to  the  state  vector. 


x(t)  = (x,y,z,x,y,z,ad,at#ct  ) T (4.10) 

and  the  implementation  of  the  complete  MARV  equations-of-motion, 

Eq.  (2.2).  As  in  the  BRV  case,  the  parameters  are  modeled  as 

a.  =n  , a.  = n ,a  =n  where  the  noise  processes  are  assumed 
d a . t a.  c a 
d t c 

to  be  white  Gaussian. 

This  filter  may  also  be  used  to  track  a BRV  trajectory. 

In  using  it  to  track  BRV's,  one  should  expect  that  the  maneuver 
parameter  estimates  are  only  caused  by  noise.  The  advantage  of 
using  the  MARV  filter  to  track  the  BRV  trajectory  is  that  when 
the  RV  executes  unexpected  maneuvering,  the  filter  can  adjust 
automatically  and  still  maintain  target  track.  The  disadvantage 
is  that  the  MARV  filter  will  have  poorer  estimation  performance 
during  the  ballistic  portion  of  the  re-entry  than  would  the  BRV 
filter.  In  addition,  the  redundant  states  carried  along  by  the 
MARV  filter  unnecessarily  increase  the  computational  load.  One 
approach  to  alleviate  this  problem  is  to  use  the  BRV  filter 


i 
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initially  and  switch  to  the  MARV  filter  after  detecting  the  maneu- 
ver. This  combined  filter  is  also  tested  in  the  simulation  study. 

5.  METHODS  OF  ADAPTIVE  FILTERING 

In  this  section,  the  characteristics  of  the  appropriate 
process  noise  needed  to  complete  the  description  of  the  adaptive 
extended  Kalman  filter  are  discussed.  Functionally , this  noise 
should  reflect  those  uncertainties  or  discrepancies  between  the 
assumed  dynamic  model  and  the  actual  re-entry  phenomena.  Prag- 
matically, the  problem  is  one  of  selecting  noise  levels  (variances) 
which  are  large  enough  to  prevent  filter  divergence  yet  small 
enough  to  retain  the  learning  potential  of  the  filter  model;  thus 
avoiding  unnecessarily  large  RMS  errors  in  the  estimates  due  to  a 
heavier  reliance  on  the  individual  measurements.  As  the  process 
noise  is  increased,  the  prediction  accuracy  decreases,  thus  re- 
quiring large  radar  track  gates.  In  addition,  our  ability  to  dis- 
tinguish between  possible  interfering  targets  is  diminished. 

From  the  discussion  in  the  previous  section,  the  state 
augmentation  method  for  parameter  estimation  (i.e.,  a^,  a^,  ac) 
requires  the  use  of  process  noise.  However,  the  use  of  BRV  and 
polynomial  filters  for  MARV  tracking  requires  even  higher  process 
noise  levels  be  applied  to  most  states  of  the  target  dynamics. 

The  experience  gained  in  determining  the  process  noise  for  para- 
meter identification  in  BRV  tracking  problem  and  its  extension' 
to  the  MARV  tracking  is  discussed  in  the  first  subsection.  The 


19 


' 


I If  J 

subject  of  adaptive  filtering  has  been  a topic  of  much  research.  ' 
A brief  discussion  of  adaptive  methods  and  their  applicability  to 
MARV  tracking  is  given  in  Section  5.2.  The  application  of  the  ad- 
aptive filtering  method  proposed  in  Ref.  14  to  complement  the  BRV 
and  polynomial  filters  for  MARV  tracking  is  discussed  in  Section 
5.3. 

5.1  Constant  Process  Noise 

The  initial  criterion  for  selecting  the  process  noise 
is  to  simply  ensure  track  maintenance  during  worst  case  conditions, 
i.e.,  large  measurement  variances,  substantial  nonlinear  drag  de- 
celerations, and  severe  evasive  maneuvers.  The  noise  covariance 
matrix  is  selected  prior  to  the  mission  and  includes  only  those 
elements  of  the  matrix  corresponding  to  parameters  where  we  might 
expect  the  greatest  source  of  errors.  For  the  polynomial,  BRV, 
and  MARV  filters,  zero-mean  Gaussian  process  noise  is  added  to 
acceleration  rates,  n(t)  = (0,0,0,0,0,0,n«,n--,n-.) ; drag  rates  (or 
equivalently  a),  n(t)  = (0,0,0,0,0,0,na) ; and  drag-lift  rates, 

n(t)  = (0,0,0,0,0,0,n  ,n  ,n  ),  respectively.  The  variances  of 

ad  at  c 

these  Gaussian  processes  are  selected  on  a trial-and-error  basis 
by  adjusting  the  levels  during  simulation  exercises  until  track 
can  be  maintained  throughout  re-entry. 

For  the  BRV  filter  a procedure  which  increases  the  noise 
level  in  accordance  with  the  magnitude  of  the  estimated  drag  de- 
celeration has  proven  to  work  quite  well  for  tracking  ballistic 
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re-entry  vehicles.  This  method  is  motivated  by  the  fact  that  the 
major  source  of  error  orginates  from  the  drag  model  and  that  these 
model  errors  become  increasingly  pronounced  as  the  air  'imsity  in- 
creases in  drag;  thus,  allowing  the  filter  to  adapt  to  the  com- 
paratively rapidly  changing  drag  at  lower  altitudes.  For  this 

2 2 

reason,  the  process  noise  for  a is  defined  as  = (ca)  where  a 
satisfactory  value  for  c (based  on  experience)  is  c = 0.1. 7 10 

To  date,  little  is  known  about  the  process  noise  level 
needed  for  the  other  two  parameters,  a,  and  a . in  the  MARV  fil- 
ter.  In  the  simulation  study,  they  are  selected  to  be  represen- 
tative of  a uniform  distribution  of  the  range  of  possible  para- 
meter variation. 

The  above  process  noise  selection  procedure  is  of  course 
not  "optimal."  It  represents,  however,  the  result  of  some  limited 
numerical  experience  and  is  easily  implemented. 

5 . 2 Optimal  Adaptive  Filtering 

The  optimum  Kalman  filter  requires  complete  knowledge  of 

system  dynamics  and  statistics.  A mismatched  Kalman  filter  could 

2 

ultimately  lead  to  filter  divergence.  The  method  which  attempts 
to  identify  the  uncertain  part  of  the  system  dynamics  and  statis- 
tics on-line  with  the  filtering  process  is  called  adaptive  filter- 
ing. An  even  more  versatile  approach  is  to  lump  all  the  modeling 
uncertainties  in  the  system  process  noise.  This  method  is  certainly 
nonoptimal  in  its  own  right,  however,  it  enables  a filter  based  upon 
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a poor  dynamic  model  to  still  lock  on  to  the  system  output  and  is 
the  approach  used  in  this  paper.  Much  work  has  been  done  in  this 
area  in  attempting  to  rigorously  and  optimally  identify  the  un- 
known part  of  the  system.  In  the  problem  addressed  here,  we  are 
interested  only  in  identifying  the  proper  process  noise  variance. 


Q (t)  . 


Representative  work  along  this  line  may  be  found  in 


Refs.  16-20.  These  methods  include  use  of,  1)  the  properties  of 

the  innovation  process,  2)  the  Bayesian  formulation  which 

includes  the  covariance  Q(t)  in  the  a posteriori  density  function,^ 

20 

and  3)  the  correlation-type  estimator  based  upon  residuals.  All 
of  these  methods  require  extensive  computational  resources  since 
all  the  data  are  iteratively  reprocessed  for  each  new  estimate. 

To  circumvent  some  of  the  computational  requirements  most  of  these 
''optimal"  methods  are  subplanted  by  some  sort  of  suboptimal  algo- 
rithm employing  simpler  estimators  and  limited  memory  filters. 

For  most  cases  these  suboptimal  algorithms  still  require  unaccept- 
able computer  resources  yet  are  of  questionable  reliability. 

Due  to  processing  time  constraints  we  have  considered 
only  the  simple  (even  nonoptimum)  methods,  in  this  tracking  study. 
5.3  A Simple  Adaptive  Filtering  Method 

Detection  of  an  unexpected  maneuver  as  well  as  any  com- 
pensation that  may  be  taken  is  generally  based  upon  the  behavior 

. 'b 

of  the  residuals,  Ay^_ . The  covariance  matrix  of  this  residual  is 


, 
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computed  in  the  filtering  algorithm  as 


P , = H,  P,  , H,  + R. 
r,k  k k/k-1  k k 


(5.1) 
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Jazwinski  suggested  a real-time  algorithm  which  determines  the 
appropriate  process  noise  based  upon  the  statistical  behavior  of 
the  residuals.  The  attractiveness  of  this  method  is  in  the  sim- 
plicity of  its  implementation.  Even  though  there  is  no  criterion 
of  optimality  involved,  it  is  shown  in  the  numerical  results  that 
this  method  enables  the  BRV  and  polynomial  filter  to  track  the 
MARV.  The  original  discussion  in  Ref.  14  pertained  to  linear  fil- 
tering, it  will  be  restated  here  using  our  notations  in  nonlinear 
filtering. 

Let  denote  the  covariance  matrix  which  appears 

in  the  prediction  cycle  due  to  the  process  noise,  i.e.. 


Zk/k-l  $k-l(Qk-lAtk-l)$k-l 


(5.2) 


Assuming  that  the  matrix  which  appears  in  the  residual  covariance 
due  to  is  diagonal,  the  Jazwinski  estimator  states 


1 ™ 1 
At  |_-^k^k  Pr , kj ii  ‘ 


[^k^k/k-l1^] . . = | if  Positive  (5*3) 

0 ; otherwise 

This  estimator  basically  requires  that  the  residual  must  be  within 
a reasonable  range  of  the  residual  covariance  as  predicted  by  the 
Kalman  filter.  If  it  fails  to  satisfy  this  requirement,  the  pro- 
cess noise  is  increased  accordingly  to  enlarge  the  corresponding 
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residual  covariance  so  that  the  filter  update  equation  places 
heavier  reliance  on  the  most  recent  measurement. 


Ultimately,  the  matrix  must  be  determined.  In  the 
tracking  problem  discussed  here,  one  may  assume  that  the  position 
estimation  error  is  caused  by  the  errors  from  the  velocity  esti- 
mates. For  the  case  of  BRV  filter,  the  matrix  becomes 


""03x3  t q3x4 


The  oa  of  above  is  determined  by  the  method  discussed  in  Section 
2 2 2 

5.1  while  a*,  a*,  a«  will  be  computed  from  Eqs.  (5.2)  and  (5.3). 
x y z 

It  is  known  that  the  transition  matrix  $ may  be  approximated  by 
the  following  expression 


| At  0 


At  0 


At  0 


where  At  is  the  time  interval  between  measurements.  Using  (5.5) 


and  (5.4)  and  carrying  out  the  multiplication  of  (5.2)  yield 


I 

# 

i 
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Jk/k-l 
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a 

a 

(5.6) 

The  H matrix  in  (5.3)  is  the  Jacobian  matrix  of  the  measurement 
equations.  In  the  tracking  application,  it  represents  the  lin- 
earized transformation  from  state  variables  to  the  radar  measure- 
ment variables.  With  (5.3),  one  is  always  able  to  compute  the 
position  component  variances  in  the  state  space  from  residuals 
in  the  measurement  space.  Let  the  position  component  variance 
be  denoted  by  o£,  a , and  a z,  one  obtains  a - = ax/At  , o - » °y/At  , 

and  o-  = a2/ At2  from  (5.6).  This  completes  the  computation  of  the 
z z 

Q matrix. 

Several  problems  emerge  from  this  rather  simple  adaptive 
noise  estimator.  This  estimator  as  outlined  above  is  based  upon  a 
single  residual  which,  as  Jazwinski  points  out,  may  not  be  statis- 
tically significant.  Random  fluctuations  of  the  residual  could 
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cause  unnecessary  response  from  the  estimator.  One  possible  course 
of  action  is  to  use  the  smoothed  residuals  over  a large  number  of 
measurements . 
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Other  approaches  of  preventing  an  over-reaction  are  to  do 
one  or  some  of  the  following: 

1.  Activate  the  adaptive  estimator  only  during 
a detected  maneuver  or  within  an  altitude 
interval  over  which  maneuvering  is  expected 
to  occur. 

2.  Limit  the  amount  of  noise  that  may  be  added — 
corresponding  to  the  maximum  maneuver  ex- 
pected. 

3.  Change  Eq.  (5.3)  to  the  form 

i 

/v,  T _ 

- c Pr,k 

where  "c"  is  a constant  to  be  determined  env 
pirically. 


6.  NUMERICAL  EXAMPLES 

j 
j 

In  this  section  the  numerical  results  obtained  by  apply- 
ing simulated  data  to  the  filters  are  presented.  The  simulation 
program  includes  a trajectory  simulator  and  the  tracking  filters. 

The  trajectory  simulator  consists  of  a numerical  integration  pro- 
gram whicn  generates  noise-free  trajectories  in  Cartesian  coordin- 
ates and  a radar  simulator  which  transforms  the  state  variables 
into  the  radar  measurement  state  space  and  adds  noise  to  the  mea- 
surements . There  are  four  algorithms  used  in  the  testing.  They 
are  the  polynomial  filter,  BRV  filter,  MARY  filter,  and  the  com- 


BRV  filter  initially  and  switches  to  a MARV  filter  after  detecting 
the  maneuver.  The  detection  algorithm  is  that  described  in  Section 
3.2.  The  simulator  runs  in  a Monte  Carlo  fashion  to  obtain  che 
means  and  standard  deviations  of  the  estimates.  The  results  from 
each  filter  are  compared  in  terms  of  position  rms  error,  velocity 
rms  error,  and  the  means  and  standard  deviatiox:s  of  parameter  es- 
timates. Evaluation  of  these  filters  based  on  real  data  will  not 
be  discussed  in  this  report.  Due  to  the  model  discrepancies  which 
always  arise  between  a mathematical  model  and  the  actual  physical 
process,  the  validity  of  applying  such  techniques  to  the  real  world 
can  only  be  established  after  a thorough  exercise  with  actual  field 
data.  This  subject  is  currently  under  investigation  and  will  be 
documented  in  a future  Lincoln  Laboratory  report. 

Three  trajectories  having  different  maneuvering  scenarios 
are  used  to  exercise  these  filters.  The  first  trajectory  (Tl)  can 
be  described  as  a moderate  maneuver  in  which  a combined  dive  and 
left  turn  both  having  equal  magnitude  begins  at  30  km  altitude. 

The  maneuvering  force  increases  gradually  to  about  128  g at  around 
23  km  and  then  decreases  to  zero  at  about  16  km.  At  16  km,  the 
RV  initiates  a climb  and  eventually  reaches  120  g at  around  10 
km  and  decreases  to  zero  at  around  5 km.  The  second  trajectory 
(T2)  undergoes  more  severe  maneuvers.  It  instantaneously  jumps 
to  a 160  g left  turn  at  35  km.  The  turning  coefficient  (at)  is 
maintained  constant  until  27  km  while  the  lift  force  builds  to  a 
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maximum  of  500  g due  primarily  to  the  increase  in  air  density. 


The  left  turn  force  then  drops  instantly  to  about  45  g at  27  km 


and  then  increases  to  152  g at  18  km.  At  thi:-  altitude  it  re- 


duces to  about  20  g and  remains  small  until  3 km.  The  lift  force 


is  zero  below  this  altitude.  The  ballistic  coefficient  of  T2  also 


jumps  to  simulate  a sudden  change  in  the  lift  induced  drag  force. 


The  T2  trajectory  is  indeed  unrealistic  and  it  is  included  solely 


for  the  purpose  of  testing  filter  response.  The  third  trajectory 


(T3)  takes  only  minor  maneuvers.  A combined  dive  and  left  turn 


with  equal  magnitudes  starts  at  30  km  and  gradually  increases  to 


5 g at  25  km  then  decreases  to  zero  at  20  km.  At  20  km,  the  RV 


initiates  a combined  climb  and  right  turn  with  equal  magnitudes 


and  eventually  reaches  10  g at  15  km  and  decreases  to  zero  at  10 


km.  It  dives  and  turns  to  the  left  again  at  10  km  and  reaches  10 


g at  5 km  and  decreases  to  zero  at  1 km.  This  trajectory  closely 


resembles  a BRV  trajectory.  It  is  included  to  test  the  sensitivity 


of  the  MARV  filter. 


A dish  radar  is  assumed  located  at  the  origin  of  the 


trajectory  coordinate  system.  The  measurement  variables  of  a 


dish  radar  include  range  (R) , azimuth  iA) , and  evaluation  (E) . 


Assuming  that  the  trajectory  coordinate  system  uses  x-axis  point- 


ing east,  and  y-axis  pointing  north,  and  z-axis  perpendicular  to 


the  local  horizontal  plane,  the  radar  measurement  variables  are 


related  to  the  state  variables  by  the  following  equations. 


I 


n 


R = Vx2  y2  + z2 

A = tan"1  £ (6.1) 

E = tan"1  — 

J 2 2 

- \x  +y 

i . A range  measurement  standard  deviation  of  one  meter  is  assumed. 

For  waking  targets,  a one-meter  standard  deviation  is  still  repre- 
sentative since  coherent  burst  waveforms  can  be  used  for  range 
marking  and  clutter  suppression.  The  angle  measurement  standard 
deviation  is  assumed  to  be  .17  milliradian.  A data  rate  of  10 
measurements  per  second  is  utilized  throughout  the  trajectory. 

11 

The  process  noise  is  introduced  in  the  MARV  filter  only 
in  the  states,  representing  parameters  (i.e.f  a^,  a^,  and  «c) • The 
variance  of  input  noise  for  is  (.la^;  just  as  in  the  BRV  case. 

The  variances  of  process  noise  for  the  other  two  parameters  are 
determined  by  the  range  of  parameter  variation,  the  inherent  fil- 
ter stability  and  the  balance  of  bias  and  random  errors.  After 

. -7 

testing  over  a range  of  values,  they  were  selected  to  be  5x10 

_g  _ O 

for  Tl,  5x10  for  T2,  and  5x10  for  T3.  The  track  is  initiated 
at  80  km  altitude.  The  adaptive  portion  of  the  BRV  and  polynomial 
filters  is  activated  at  45  km. 

The  estimated  position  rms  errors  made  by  all  four  algo- 
rithms in  using  trajectories  Tl,  T2,  and  T3  are  presented  in  Figs. 
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1,  5,  and  9,  respectively.  All  algorithms  performed  satisfacto- 
rily. If  the  only  tracking  requirement  is  to  maintain  the  vehicle 
in  track,  the  polynomial  filter  is  certainly  most  attractive  since 
it  requires  the  least  computation. 

Recalling  the  fact  that  the  adaptive  filtering  algorithm 
enables  the  filter  to  rely  heavier  on  current  measurements,  note 
the  sudden  increase  of  position  error  at  45  Ian  altitude  which  in- 
dicates the  activation  of  the  adaptive  feature.  If  the  adaptive 
filtering  algorithm  was  not  used,  the  BRV  filter  would  diverge 
quickly  from  the  trajectory.  This  indicates  a trade-off  between 
a range  of  tolerable  rms  errors  and  a range  of  intolerable  bias 
error  (loss  of  track) . Notice  that  large,  impulse-like  errors  ap- 
pear with  MARV  filter  and  the  combined  filter  in  tracking  T2  tra- 
jectory. As  described  ear'ier,  the  maneuvering  force  history  of 
T1  is  moderate  (and  realistic) . The  MARV  filter  responded  to  this 
maneuvering  smoothly.  The  change  of  maneuvering  force  of  the  T2 
is  sudden  and  drastic.  The  impulse-like  error  of  the  MARV  filter 
represents  the  system  delay  in  responding  to  such  a change.  The 
large  transients  in  the  combined  filter  observed  on  both  trajec- 
tories occur  as  one  switches  from  the  BRV  to  the  MARV  filter. 

This  effect  may  also  be  seen  in  other  state  estimates  as  well. 

The  advantage  of  using  this  combined  algorithm  is  the  better  per- 
formance achieved  and  the  less  computation  required  during  the 
nonmaneuvering  region.  Unfortunately,  the  transient  phenomenon 
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lasts  over  a 10  km  altitude  interval.  This  is  due  in  some  respect 
to  the  fact  that  the  method  used  in  initiating  the  MARV  filter  in 
the  combined  algorithm  is  rather  arbitrary.  An  improved  initia- 
tion algorithm  could  smooth  the  transient  somewhat. 

The  velocity  rms  errors  of  using  trajectories  Tl,  T2,  and 
T3  are  presented  in  Figs.  2,  6,  and  10,  respectively.  The  polyno- 
mial filter  estimates  have  the  largest  errors.  The  transients  in 
the  combined  filter  are  again  apparent.  The  averaged  ballistic 
coefficient  estimates  of  trajectories  Tl,  T2,  and  T3  are  presented 
in  Figs.  3,  7.  and  11,  respectively.  Also  shown  in  these  figures 
are  the  true  underlying  parameters  and  the  one  standard  deviation 
level.  The  estimates  made  by  the  polynomial  filter  are  very  er- 
ratic . The  estimates  made  by  the  MARV  filter  are  very  good  and 
follow  the  parameter  variation  closely.  The  combined  filter  also 


estimated  the  coefficient  well  except  during  the  transition  period. 


The  estimates  made  bv  the  BRV  filter  exhibit  substantial  biases  in 


the  maneuvering  region.  It,  however,  is  much  more  stable  than  the 
polynomial  estimate.  From  the  one  standard  deviation  interval,  it 


is  found  that  the  random  errors  are  usually  within  10%  of  the  esti- 
mated values  except  those  of  the  polynomial  filter. 

Figures  4 , 8 , and  12  present  the  maneuvering  parameter 
estimates  of  trajectories  Tl,  T2,  and  T3,  respectively.  Only  the 
MARV  filter  and  the  combined  filter  can  provide  these  estimates. 

The  estimates  follow  the  parameter  closely.  Notice  in  Fig.  8 the 
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turning  coefficient  takes  an  abrupt  jump  while  the  estimates  re- 


spond to  this  change  with  only  about  six  radar  pulse  delay.  The 


random  error  of  maneuvering  parameter  estimates  of  the  T3  trajec- 


tory is  rather  large.  Notice  that  the  magnitudes  of  the  maneuver- 


ing parameters  of  this  trajectory  are  small,  the  estimtes  are 


mostly  buried  in  noise.  One  could  improve  the  situation  by  further 


reducing  the  process  noise  level  on  these  parameters.  It,  however. 


implies  using  the  a priori  knowledge  which  are  usually  not  avail- 


able in  a real-time  tracking  application.  Figure  13  presents  the 


maneuvering  parameter  estimates  of  T3  made  by  the  MARV  filter  with 


process  noise  variances  equal  to  5x10  . Notice  that  the  random 


error  is  considerably  smaller  in  this  case.  A useful  analysis 


will  be  to  relate  the  range  of  parameter  variation,  the  process 


noise  level,  and  the  estimation  arms  errors.  This  analysis  may  be 


applied  for  off-line  study  of  vehicles  exercising  small  maneuvers. 


The  anomalous  transient  effects  of  the  combined  filter  can  again 


be  seen  in  these  results. 


7.  CONCLUSIONS 


Three  basic  filters  which  can  be  used  for  the  tracking 


of  a maneuvering  re-entry  vehicle  have  been  presented.  They  are 


the  extended  adaptive  Kalman  filters  based  upon  MARV,  BRV,  and 


polynomial  dynamic  models.  A fourth  algorithm  which  combines  the 


use  of  a nonadaptive  BRV  filter  and  the  MARV  filter  through  the 


application  of  a generalized  maximum  likelihood  ratio  test  is  also 
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presented.  All  algorithms  are  tested  based  upon  the  simulated 
trajectory  data. 

From  the  simulation  study,  it  is  found  that  all  filters 
can  track  the  target  successfully  in  that  they  all  have  comparable 
position  estimation  errors.  If  the  only  tracking  objective  is  to 
maintain  the  target  in  track,  the  polynomial  filter  is  the  most 
attractive  one  to  use  since  it  requires  least  computation.  The 
attractiveness  of  the  MARV  filter  is  its  ability  to  provide  man- 
euvering parameter  estimates  and  more  accurate  ballistic  coeffi- 
cient estimates  during  target  maneuvering.  It  is  shown  that  the 
estimates  have  only  small  errors  and  the  filter  can  rapidly  fol- 
low the  severe  variations  of  the  underlying  true  parameters.  The 
disadvantage  of  using  the  MARV  filter  lies  in  the  computational 
burden  imposed  on  a real-time  system.  The  BRV  filter  fits  some- 
where in  between  in  that  it  does  not  require  as  much  computation 
as  the  MARV  filter  while  still  provides  a reasonable  ballistic 
coefficient  estimate  when  the  target  is  undergoing  maneuvers.  It 
is  found  that  severe  transients  exist  in  the  combined  filter  which 
occur  when  switching  from  the  BRV  to  the  MARV  filter  and  an  appro- 
priate algorithm  for  handover  must  be  determined. 

Much  more  work  still  has  to  be  done  in  exercising  these 
filters  on  real  data.  The  real  data  contains  properties  which 
may  not  be  fully  modeled  by  mathematics.  Such  properties  include 
the  range  measurement  degradation  due  to  wake  contamination. 
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uncertainties  in  angle  measurement  error  modeling,  among  others. 

Due  to  the  complexity  expanded  in  the  MARV  filter,  it  may  be  more 
sensitive  to  these  real  data  uncertainties  mentioned  above. 

Some  fundamental  conclusions  may  also  be  drawn  at  this 
point.  It  is  shown  that  the  extended  Kalman  filter  can  perform 
successfully  in  estimating  the  states  of  a severely  nonlinear  sys- 
tem. In  addition,  the  state  augmentation  method  for  parameter 
estimation  is  effective  even  in  systems  having  large  parameter 
variations.  The  simple  adaptive  filtering  method  employing  pro- 
cess noise  to  compensate  for  the  model  uncertainties  is  extremely 
powerful.  When  only  the  estimates  of  lower  order  states  {such  as 
position)  are  desired,  large  modeling  errors  may  be  tolerated 
with  little  sacrifice  in  the  perf ormance . These  observations  are 
supported  with  examples  shown  in  this  paper.  One  cannot,  of  course 
claim  that  these  methods  work  for  all  nonlinear  systems  with  large 

parameter  variations.  They  do  represent  useful  methods  applicable 
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to  many  nonlinear  systems. 
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(a)  Turning  Coefficient  Estimate  (k)  Turning  Coefficient  Estimate 
of  MARV  Filter  of  Combined  Filter 
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(c)  Climbing  Coefficient  Estimate  (3)  Climbing  Coefficient  Estimate 
of  MARV  Filter  of  Combined  Filter 


Fig.  4.  Maneuvering  parameter  estimate  of  Tl. 
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TN-1975-59 (8a) 


TN-1975-59(8b) 


(a)  Turning  Coefficient  Estimate 
of  MARV  Filter 

TN-1975-59 (8c) 


Turning  Coefficient  Estimate 
of  Combined  Filter 
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(c)  Climbing  Coefficient  Estimate  (d)  Climbing  Coefficient  Estimate 
of  MARV  Filter  of  Combined  Filter 


Fig.  8.  Maneuvering  parameter  estimate  of  T2 


fTN-1975-59 (13a) 


(a)  Turning  Coefficient 


fTN-1975-59(13bj 


(b)  Climbing  Coefficient 


Fig.  13.  Maneuvering  parameter  estimate  of  T3  by  MARV 
filter  with  small  process  noise. 
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APPENDIX  A 

Derivation  of  MARV  Differential  Equations  of  Motion 


In  this  Appendix,  the  MARV  equations  of  motion  are  derived. 
A flat,  nonrotating  earth  with  constant  gravity  model  is  assumed. 
For  the  altitude  region  below  100  km  which  is  our  concern,  this 
assumption  introduces  only  small  modeling  errors  while  greatly 
simplifying  the  equations.  It  is  well  known  that  a ballistic  tra- 
jectory may  be  described  by  the  following  vector  equation 


where 


4-  1 2 . . 1 4 “4 

a(t)  = ipv  (t)-  ud  + g 


(A.  1) 


a(t)  is  the  total  acceleration  applied  on  the  vehicle 
p is  the  air  density 

v(t)  is  the  magnitude  of  the  vehicle  velocity 

u.  is  the  unit  vector  along  the  drag  force  direction 
which  is  opposite  to  the  velocity  vector 

g is  the  gravity  force  vector 

6 is  the  zero  lift  ballistic  coefficient  defined  as 

B = g-™  where  m=BRV  mass,  CdQ=zero  lift  drag 
d0‘ 

coefficient,  and  A=reference  area  for  drag  evalu- 
ation. 

In  tracking  algorithms,  the  filter  usually  estimates  the  ballistic 
parameter  a which  is  defined  as  inverse  of  B. 

When  the  vehicle  undertakes  a maneuver,  a third  force 
term,  lift,  is  introducted.  The  lift  force  is  in  a plane  perpen- 
dicular to  the  velocity  vector  (Fig.  A.l).  Before  starting  the 
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a)  lift  force  is  perpendicular  to  drag  force 

b)  turn  and  climb  forces  are  components  of  lift  force 

c)  turn  force  is  on  the  local  horizontal  plane 

di  turn,  climb,  and  drag  forces  form  an  orthogonal 
coordinate 


Fig.  A. 1 . Geometry  of  lift  and  drag  forces. 


MARV  equations,  it  is  useful  to  summarize  the  concepts  associated 
with  lifting  bodies.  Consider  the  motion  of  a point  mass  in  the 
atmosphere  with  a velocity  v(t).  The  total  drag  force  is  D(t) 


D ( t)  = |cdApv2(t) 


(A. 2) 


i 


where  = total  drag  coefficient.  Let  L(t)  denote  the  lift  force. 
The  magnitude  of  the  lift  force  is 


L(t)  = 1 cLAPv2(t) 


(A. 3) 


where  CL  = lift  coefficient.  The  lift  vector,  L(t),  is  always 
perpendicular  to  the  drag  force  D(t),  as  shown  in  Fig.  A.l. 

A lifting  body  contributes  extra  drag.  It  is  common  prac- 
tice to  present  this  relationship  between  total  drag  D(t)  and  total 
lift,  L ( t) , by  means  of  the  so-called  parabolic  polar,  which  is  ex- 
pressed by  the  equation 


where 


Cd  Cd0  + kCL' 


= zero  lift  drag  coefficient  (i.e.,  the  one 
that  characterizes  a BRV) 


k = constant  that  depends  on  the  body 
The  production  of  different  lift  forces  is  accomplished 
by  changing  the  lift  coefficient  CT  of  the  body.  However,  there 
is  a specific  value  for  the  lift  coefficient  denoted  by  CT * that 

It 

maximizes  the  so-called  lift-to-drag  ratio. 

Q 

Lift-to-drag  ratio  A = 

~ D vT)  C_ 


CdO+kCL 
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It  is  easily  found  that  this  value  CL*  of  the  lift  coefficient  is 

C * = ^0 

k 


which  leads  to 

maximum  lift-to-drag  ratio  = 

2i/E5^ 

Another  common  practice  is  to  express  CT  in  terms  of  CT  * 

J_i  li 

by  the  so-called  lift-parameter  X 


CT  (t)  A X (t)C*;  0<X(t)<l 

Li  — J_»  — — 

Using  these  notations  we  can  write: 

Total  Drag  Force  = D{t)  = |pACdQ  ^1+X2  (t)^  v2  (t)  (A.  4) 

Total  Lift  Force  = L(t)  = |pACL*X (t) v2 (t)  (A.  5) 


Note  that: 

1 2 

Zero  Lift  Drag  Force  = ^pACd0v  (t) 
Lift-Induced  Drag  Force  = ipACdQX2 (t)v2 (t) 


Using  the  above  discussions,  the  maneuvering  trajectory 
may  be  described  by  the  following  vector  equation 


a(t) 


= |pv2(t)^(l+X2)Sd+X6£S^+g 


Cd0A 


(A. 6) 


where 


a 


1 


Notice  that  this  equation  is  written  free  of  coordinate  systems. 
Once  a coordinate  system  is  chosen,  set  of  state  differential  eq- 
uations may  be  written  for  simulation  and  filter  realization.  The 
lift  vector  is  on  the  plane  perpendicular  to  the  drag  vector.  In 
order  to  locate  the  lift  vector  on  the  plane,  a reference  quantity 
is  necessary.  If  a Cartesian  coordinate  is  used  and  the  lift  vec- 
tor reference  is  chosen  to  be  the  angle  between  the  lift  vector 
and  the  local  horizontal  plane,  Eq.  (2.1)  results.  As  discussed 
in  the  text,  one  can  also  decompose  the  lift  vector  into  a turn 
force  and  a climb  force.  Using  this  decomposition,  Eq.  (A. 6)  may 


be  rewritten  as 


a(t)  = 


= ^pV2(t)^CX 


(1+X2)ud  + X6 


.u.  + X5  u \ 
t t c c I 


(A. 7) 


The  corresponding  state  equations  of  (A. 7)  in  a Cartesian  coordin- 
ate is  Eq.  (2.2) . 
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APPENDIX  B 


Range,  Azimuth,  Elevation,  and  Range  Rate  Estimate 
Errors  of  Numerical  Examples 

In  this  Appendix,  figures  showing  range,  azimuth,  eleva- 
tion, and  range  rate  estimation  errors  of  numerical  examples  given 
in  this  report  are  presented.  Results  of  using  trajectories  Tl,  T2, 
and  T3  are  shown  in  Figs.  B.l  to  B.4,  B.5  to  B.8,  and  B.9  to  B.12, 
respectively.  Errors  shown  in  each  figure  include  estimate  bias 
and  one  standard  deviation  interval  developed  through  40  Monte 
Carlo  runs  of  the  algorithm.  Bias  error  is  defined  as  the  esti- 
mated value  minus  the  true  value. 

These  results  are  included  for  reference  purposes.  Many 
filter  responses  to  the  target  maneuvering  may  be  understood  by 
examining  these  results.  For  example.  Fig.  B.4(b)  presents  the 
range  rate  estimate  error  of  T2  made  by  the  adaptive  BRV  filter. 
Notice  that  a large  negative  bias  appears  yhen  the  RV  undergoes 
maneuvering.  When  the  RV  turns  sharply  away  from  the  radar,  the 
magnitude  of  the  true  range  rate  is  rapidly  decreasing.  The  BRV 
filter  which  does  not  have  the  lift  force  component  modeled  esti- 
mates the  range  rate  corresponding  to  a vector  sum  of  the  drag 
and  lift  forces.  This  range  rate  bias  then  in  turn  causes  the  8 
estimate  to  be  biased  as  shown  in  Fig.  7(c).  The  MARV  filter 
which  has  the  lift  force  modeled  has  an  unbiased  range  rate  esti- 
mate. The  estimation  variance  is  high  due  to  the  process  noise 
introduced  in  the  drag/lift  parameter  states. 
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(c)  BRV  Filter 
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(d)  Poly.  Filter 


Fig.  B.l.  Range  estimate  errors  of  Tl. 
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(a)  MARV  Filter 


(b)  Combined  Filter 
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(a)  MARV  Filter 
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(b)  Combined  Filter 
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(c)  BRV  Filter 


(d)  Poly.  Filter 


Fig.  B.ll.  Elevation  estimate  errors  of  T3. 
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